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Prufungsantrag gem. § 44 PatG ist gestellt 

(S) Drehleiter 

@ Die Erfindung bezieht sich auf eine Drehleiter oder der~ 
gleichen mit mehreren Leiterteilen, die mit Hilfe einer 
Steuerung gesondert beweglich sind. Die Steuerung soil 
so ausgebildet werden, daB Schwingungen der Leiter 
wtiitgehend unterdruckt werden. Zu diesem Zweck bildet 
die Steuerung zunachst das ideal isierte Bewegungsver- 
halten der Leiter in einem dynamischen Model I mit Hilfe 
von Differenzialgleichungen ab. Dia Vorsteuerung be- 
rechnet die Ansteuergrof^en der Antriebe der Leiterteile 
fur eine im wesentlichen schwingungsfreie Bewegung 
der Leiter aus dem dynamischen Modell. 
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Beschicibung 

10001 ] Die Firfindung betrifft eine Drehleiteroderdergleichen mil einer Steuerung fur die Bewegung derLeiterteile ge- 
maB dcm Obcrbegriff des Anspruchs 1 . 

5 |0002| Till FJn/xslnen bcfaBi sich die Erfindung mit einer Drehleiler, beispielsweisc einer Feuerwehrleiler, oder eineni 
ahnlichen Gerat, cLwa CJclcnk- oder Teleskopmastbuhnen und Hubreltungsgediten. Derartige Gerate sind im Allgemei- 
ncn urn cine scnkrcchte Achse drehbar und im iibrigen in Bezug auf die Horizontale aufrichtbar auf etnem Fahrzeug 
inonticrt . Die licwcgung dcr Drehleiler und insbesondere eines am Endc der Drehleiter angebrachlen Fahrkorbes erfolgt 
mil I liUe einer Steuerung, durch die der Fahrkorb in dem Arbeitsraum bewegt wird. NatuigemaB ist es wunschenswert, 

10 daB der Fahrkorb seine Zielposiiion so rasch wie mogiich erreicht, Eine relaliv hohe Bewegungsgeschwindigkeit des 
Fahrkorbes crfordcrt enlsprcchcndc Beschleunigungs- und Verzogerungsphasen. Dadurch sowie durch exteme Einflusse, 
wie etwa Windbelastung, kann es zu Pendelbewegungen und Schwingungen der Leiter kommen. 

[0003] l^ic Steuerung von Dnehleitem der hier interessierenden Art umfaBt /.umeist Handhebel, mit denen die Bewe- 
gungen der einzelnen Leiterteile eleku-ohydraulisch oder auch direkt hydraulisch gesteuert weiden konnen, Im Falle ei- 
15 rein hydrauHschcn Steuerung wird die Handhebelauslenkung direkt in ein hierzu proportionales Steuersignal fur ein 
Proportionalventil des cnLsprechenden Antriebs umgesetzt. Dabei kdnnen Dampfungsventile dazu dienen, die Bewegun- 
gen weniger ruckartig und sanflcr im Obeigang zu machen. Dies fuhrl haufig zu stark gedampften Einsteilungen mit trS- 
gem Ansprechverhallen. 

[0004] Bei eiekirohydraulischcn Stcuerungen wird zunachst vom Handhebel ein elektrisches Signal erzeugt, das in ei- 
20 nem Steuergerat mit Mikroprozessor weilcrvcrarbeitet wird und schlieBlich zur Steuerung eines hydraulischen Propor- 
tionalventil verwendel wird. Dabei kann das clektrische Signal durch Rampenfunktionen gedampft werden, damit die 
Bewegung der Drehleiler weniger ruckartig und sanfter wird. Die Steilheit der Rampenfunktion bestimmt das Damp- 
fungsverhalten und isl auf dcr andcren Scile MaB fur das Ansprechverhallen. 

[0005] Sofem die bekannlen I^item Dampfungselemente aufweisen, bedeuten dies soinit in der Regel einen verhalt- 
25 nismaBig groben KomproniiB /.wischcn den Anforderungen der Schwingungsdampfung und eines raschen Ansprechver- 
hallens. 

[0006] Dcr Erfindung licg! die Au fgabc /.ugrundc, cine Drehleiter oder dciglcichen dcr obigcn Art zu schaffcn, die cine 
Bahnsteuerung aufweist, die es gcstattct, den l^ahrkorb einer Leiter auf einer voigegebenen Bahn verhalUiismaBig rasch 
und unter akliver Dampfung auftretcnder Schwingungen zu bewegen. 

30 [0007] Diese Aufgabe wird erfindungsgetnaB durch eine Drehleiter der obigen Art gelost, die dadurch gekennzeichnet 
ist, daB die Steuerung derarl ausgebildet ist, daB das idealisierte Bewegung sverhal ten der Leiter in einem dynamischen 
Modell basierend auf DifTercnzialgleichungen abgebildet wird und aus dem dynamischen Modell die V^rsteuerung die 
AnsteuergroBen der Antriebc dcr Leiterteile fur eine im wesentlichen schwingungsfreie Bewegung der Leiter bcrechnet. 
[0008] Vorzugsweise sind ein Balinplanungsniodul und ein Vorsteuerungsblock als Telle der Steuerung voigesehen. 

35 Das Bahnplanungsmodul erzeugt eine Bewegungsbahn der Leiter im Arbeitsraum, die in Form von Zeitfunktionen fiir 
die Fahrkorbposition, Fahrkorbgeschwindigkeit, Fahrkorbbeschleunigung, den Fahrkorbruck und unter Umstanden der 
Ableitung des Fahrkorbnicks an den Vorsteuerungsblock abgegeben wird, der seinersdts die Antriebe der Leiterteile an- 
steuert. 

[0009] Das Bahnplanungsmodul ermoglicht vorzugsweise die Eingabe von kinematischen Beschrankungen fiir die 
40 Zeitfunktionen der Fahrkorbposition, Fahrkorbgeschwindigkeit, Fahrkorbbeschleunigung und den Fahrkorbruck. Das 
Bahnplanungsmodul kann auch die Ableitung der Funktion des Ruckes bilden. 

[0010] Vorzugsweise weist das Bahnplanungsmodul Steilheitsbegrenzcr zur Beriicksichtigung der kinematischen Be- 
schrankungen auf. 

[0011] Vorzugsweise erzeugt das Bahnplanungsmodul eine stetige Funktion des Rucks, aus der durch Integration die 
45 Zeitfunktionen fur Fahrkorbbeschleunigung, Fahrkorbgeschwindigkeit und Fahrkorbposition ermittelt werden. Da der 
Ruck den kritischen Zxistand bei der Bewegung d^ Leiter darstellt, ist bei Zugrundelegung der Funktion des Rucks und 
Ableitung der Qbrigen Zeitfunktionen aus diesem Ruck gewahrleistet, daB insgesamt eine akzeptable, weitgehend 
schwingungs&eie Bewegung der Leiter entsteht. 

[0012] ErfindungsgemaB umfassen die Antriebc fur die einzelnen Leiterteile hydraulische Proportionalventile, die 
50 elektrisch angesteuert werden. Diese Antriebe dienen zum Drehen der Leiter um die Hochachse, zum Aufrichten und 
Absenken der Leiter, zum Ausfahren und Einziehen der Leiter in ihrer Lange, gegebenenfalls auch fiir einen Neigungs- 
ausgleich, falls das die Leiter tragende Fahrzeug auf geneigtem Untergrund steht. 

[0013] Die Bahnsteuerung ist modular aufgebaul. Sie besteht aus einem Bahnplanungsmodul und den Achsreglermo- 
dulen. Das Achsreglermodul kann in unterschiedlichen Ausbaustufen vorliegen. Die Grundausbaustufe umfaBt nur die 
55 Vorsteuerung. In der nachslen Ausbaustufe wird die Vorsteuerung mit dem Zustandsregler kombiniert. 

[0014J Als Bahnplanungsmodul stehen zwei Altemativen zur Vertugung. Das Bahnplanungsmodul tiir den halbauto- 
matischen Betrieb, bei der die Drehleiter Uber die Handhebel im Bedienstand gesteuert wird, und das Bahnplanungsmo- 
dul fur den voU automatischen Betrieb, bei der die Drehleiter die in einer Matrix definierte Sollbahn ohne Bedieneigriff 
selbstandig abMirt. 

60 [001 5] Im folgenden werden bevorzugte Ausfuhrungsbeispiele der Erfindung anhand der beigefugten Z^ichnung n^her 

erlautert. 

[0016] Es zeigen: 

[0017] Fig. 1: Prinzipielle mechanische Struktur einer beispielhaften Drehleiter 
[0018] Fig. 2: Zusammenwirken von hydraulischer Steuerung und Bahnsteuerung 
65 [0019] Fig. 3: Gesamtstruktur der Bahnsteuerung 
[0020] Fig. 4: Struktur des Bahnplanungsmoduls 

[0021] Fig. 5: Beispielhafie Bahngenerierung mit dem vollautomatischen Bahnplanungsmodul 
[0022] Fig. 6: Struktur des halbautomatischen Bahnplanungsmoduls 
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[0023] Fig. 7: Struktur des Achsreglers im Falle der Drehachse 

10024] Fig. 8: Mechanischer Aufbau der Drehachse und Definition voll Mcxlellvariablcn 
[0025] Fig. 9: Struktur des Achsregler im Falle der Aufrichtachse 

[0026] Fig. 1 0: Mechanischer Aufbau der Aufrichtachse und Definition von Modellvariablen 

[0027] Fig. 11 : Aufrichtkincmatik der Aufrichtenachse 5 
[0028] Fig. 12: Struktur des Achsregler im Falle der Ausfahrachse 
[0029] Fig. 13: Struktur des Achsregler im Falle der Niveau achse 

[0030] In Fig. 1 ist die prinzipielle mechanische Struktur einer Drehleiter oder dei^leichen dargestellt. Die Drehlciter 
ist zumeist auf eineni Fahrzeug 1 montiert. Zur Positionierung des Falirkorbes 3 im Arbeitsraum kann der Leitersatz 5 
mit der Achse Aufrichten/Neigen 7 um den Winkel <(>a gekippt werden. Mit der Achse Ausfahren/Eiofaiir^ 9 kann die to 
Leiterlange 1 variiert werden. Die Achse Diehen 11 ermoglicht die Qrientierung um den Winkel <pn um die Ilochachse. 
Im Falle eines nicht waagrecht stehenden Fahrzeuges kann mit der Niveauachse 13 eine unerwiinschte zusatzliche Nei- 
gung beim Drehen des T^itersatyes durch Kippung des T eitergetriebes 15 um den Winkel q>isj ausgeglichen werden. 
[0031] In der Regel besitzt die Drehleiter ein hydraulisches Antriebssystem 21. Es besteht aus der vom Fahrmotor an- 
getriebenen Hydraulikpumpe 23, den Proportionalventilen 25 und dell Hydraulikmotoren 27 und -zylindem 29, Die hy- 15 
draulische Steuerung ist ineist mit Systemen mit unterlagerter Forderstromrt^elung fUr die Hydraulildkreislaufe mit load- 
sensing Eigenschaften ausgestattet. Wesentiich ist dabei, daB die Steuerspannungen usto, UstA* UstN» "stE an den Propor- 
tionalventilen durch die unterlagerte Forderstromregelung in hierzu proportionate Fdrderstrome Qtro, Qfa> Qfn> Qfe ™ 
entsprechenden Hydraulikkreislauf umgesetzt werden. 

[0032] Wesentiich ist nun, daB die 2^itfunktionen fUr die Steuerspannungen der Proportion alventile nicht mehr direkt 20 
aus den Handhebe[n bei spiels weise iiber Rampenfunktionen abgeleitet werden, sondem derart in der Bahnsteuerung 31 
berechnet werden, daB beim \ferfahren der Leiter keine Schwingungen auftreten und der Fahrkorb der gewunschten 
Bahn im Arbeitsraum folgt. 

[0033] Grundlage hierfur ist ein dynamisches Modell des Drehleitersystems mit Hilfe dessen basierend auf den Sen- 
sordaten mindestens einer der GrdBen Wy. Wh, 1, <|>a» <Pd» <Pn und den Ftihrungsvorgaben q ziei oder q^cl <liese Aufgabe ge- 25 
lost wird. 

[0034] Im folgcndcn sollcn nun zunachst die Gcsamtstruktur (Fig. 3) der Bahnsteuerung 31 crlautcrt werden. 
[0035] Der Bediener gibt entweder uber die Handhebei 35 an den Bedienstanden oder uber eine Sollpunktmatrix 37, 
die in einer vorherigen Fahrt der Drehleiter im Rechner abgespeichert wurde, die Zielgeschwindigkeiten oder die Ziel- 
punkle vor. Das voilautomatische oder halbautomatische Bahnpianungsmodul (39 oder 41) berechnet unter Beriicksich- 30 
tigung der Idnematischen Beschrankungen (max. Geschwindigkeit, Beschieunigung und Ruck) der Drehleiter daraus die 
2^itfunktionen der Soll-Fahrkorbposition bezuglich der Dreh-, Aufricht- und Ausfahrachse und deren Abldtungen, die 
in den Vektoren (pKDref, <PKAref, ]ref zusammengefaBt sind. Die SoUpositionsvektoren werden an die Achsregler 43, 45, 47 
und 49 gegeben, die daraus unter Auswertung mindestens einer der Sensonverte Wy, Wh, 1, <Pa> 9d» ^Pn Ansteuerfunk- 
tionen ustD» ustA> ustE? ustN fur die Proportion alventile 25 des hydraulischen Antriebssystems 21 berechnen. 35 
[0036] Ira weiteren werden nun die einzelnen Komponenten der Bahnsteuerung detailliert beschrieben. 
[0037] Fig. 4 zeigt die Schnittstellen des Bahnplanungsmoduls 39 oder 41. Im Falle des voUautomatischen Bahnpla- 
nungsmoduls 39 wird der Zielpositionsvektor fur den Fahrkorbmittelpunkt in Form der Koordinaten gziei=l<PKDZicb <f>KA- 
Zieu iziei]^ vorgegeben. <PKDZiei ist die Zielwinkelkoordinate in Richtung der Drehachse 11 fur den Fahrkorbmittelpunkt. 
<(>KAZiei ist die Zielwinkelkoordinate in Richtung der Aufricht/Ncigen- Achse 7 fiir den Fahrkorbmittelpunkt. Iziei ist die 40 
Zielposidon in Richtung der Achse Aus/Einfahren 9 fur den Fahrkorbmittelpunkt. Im Falle des halbautomatischen Bahn- 
planungsmoduls 41 ist EingangsgroBe der Zielgeschwindigkeitsvektor 

Die Komponenten des Zielgeschwindigkeilsvektors sind analog zum Zielpositionsvektor die Zielgeschwindigkeit in 
Richtung der Drehachse (pKDZiei* folgend von der Zielgeschwindigkeit der Aufrichten/Neigen- Achse ^KAZiei und der 
Aus- bzw. Einfahrgeschwindigkeit des Leitersatzes [ jxch Irn Bahnpianungsmodul 39 oder 41 werden aus diesen vorge- 
gebenen GrdBen die Zeitf unktionsvektoren fur die Fahrkorbposition bezuglich der Drehwinkelkoordinate und deren Ab- 
leitungen ^Di«f9 ^ Fahrkorbposition bezUglich der Aufrichtwinkelkoordinate und deren Ableitungen 9KAref und fur SO 
die Fahrkorbposition bezuglich der Ausfahrlange und deren Ableitungen Ixief berechnet. Jeder Vektor umfaBt maximal 5 
Komponenten bis zur 4. Ableitung. Im Falle der Aufrichten/Neigen Achse sind die einzelnen Komponenten: 
<PKArcf: SoU-Winkelposition Fahrkorbmittelpunkt in Richtung Aufrichtwinkel 
<p KAref- SoU-Winkelgeschwindigkeit Fahrkorbmittelpunkt in Richtung Aufrichtwinkel 

ip KAi-ef- Soll-Winkelbeschleunigung Fahrkorbmittelpunkt in Richtung Aufrichtwinkel 55 

ip KArcf • SoU-Ruck Fahrkorbmittelpunkt in Richtung Aufrichtwinkel 

(^KAreft Ablcitung Soil-Ruck Fahrkorbmittelpunkt in Richtung Aufrichtwinkel 

[0038] Die Vektoren fiir die Dreh- und Ausfahrachse sind analog aufgebaut. 

[0039] Fig. 5. zeigt beispielhaft die generierten Zeitfunktionen fur die Soll-Winkelpositionen <Pkd» <f>KAT Soll-Winkel- 
geschwindigkeiten q>KD' 9ka> Soll-Winkelbeschleunigungen, cpKO^ <Pka So]1-Ruck ipKo* 9ka vollautoma- 60 

tischen Bahnpianungsmodul ftir eine Bewegung mit der Dreh- und Aufrichten/Neigen*Achse vom Startpunkt<pKn5tart = 
0°, <(>KAsiart = 0** Zielpunkt ((>KDZiei = 90**, c|>KAZiei = 20**. Die Zeitfunktionen werden dabei so berechnet, daB keine der 
vorgegebenen kinematischen Beschrankungen, wie die maximalen Winkelgeschwindigkeiten 4>Dmax, 9Araax» die maxi- 
malen Winkelbeschleunigungen (pomax. (pAmax cder der maximale Ruck (pomax* ^Amax uberschritten wird. Hierzu wird 
die Bewegung in drei Phasen eingeteilt. Eine Beschleunigungphase I, eine Phase konstanter Geschwindigkeit n, die auch 65 
entf alien kann, und einer Abbremsphase HE. Fiir die Phasen I und HI wird als Zeitfunktion fur den Ruck ein Polynom 3. 
Ordnung angenommen. Als Zeitfunktion fur die Phase n wird stets eine konstante Geschwindigkeit angenommen. Durch 
Integradon der Ruckfunktion werden die fehlenden Zeitfunktionen fur die Beschieunigung, Cieschwindigkeit und Posi- 
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tion errechnei. Die noch freien Koeffizienten in den Zeitfunklionen werden durch die Randbedingungen beim Start der 
Bewegung, an den t Jbergangsstellen zur n^chsten bzw. vorangegangenen Bewegungsphase bzw. am Zjelpunkt sowie die 
kinematischen Beschrankungen festgelegt, wobei beziiglich jeder Achse alle kinernatischen Bedingungen uberpriift wer- 
den niussen. Im Falle des Beispieles aus Fig. 5 ist in der Phase I und m die kinematische Beschrankung der maxinialen 
5 Beschleunigung fiir die Drehachse ipomax Hmitierend wirksam, in Phase II die maximale Geschwindigkeit der Drehachse 
(pDmaji. Die anderen Achsen werden zu der die Bewegung hinsichtlich der Fahrzeit begrenzenden Achse dazu synchro- 
nisiert. Die Zeitoptiraalilat der Bewegung wird dadurch crreichu daB in einem Optimierungslauf die minimaie Gesamt- 
fahrzeil uber die Variierung des Anleils der Beschleunigungs- und Abbremsphase an der Gesaintbewegung bestimml 
wird. 

10 [0040] Fig. 6 zeigt den die Drehachse betreffenden Ausschnitt aus der Struktur des halbautomatischen Bahnplaners. 
Die Zjelgeschwindigkeitdes Fahrkorbes vom Ilandhebel des Bedienslandes <pKDZiel wird zunachst auf den Werlebereich 
der maxima] erreichbaren Geschwindigkeit <p omax normiert. Damil wird erreicht, daB die Maximalgeschwindigkeit nicht 
iiberschritten wird. Der halbaulomatische Bahnplaner besteht aus 2 SteilheiLsbegrenzcr 2. Ordnung je Achse, einem fur 
den Normalbetrieb 61 und einen fur den Schneiistop 63, zwischen denen iiber die Umschaidogik 67 hin- und hergeschal- 

15 tet werden kann. Die Zeitfunklionen am Ausgang werden durch Integration 65 gebildet. Der SignalfluB im halbautoma- 
tischen Bahnplaner soli nun anhand Fig, 6 erlautert werden. 

[0041] Im Steilheitsbegrenzer fiir den Normalbetrieb 61 wird zunachst eine Soll-Istwert-Differenz zwischra der Ziel- 
geschwindigkeit <pKDZiei und der gegenwartigen Sollgeschwindigkeit <pKDrcf gebildet. Die Differenz wird mil der Kon- 
stanten Ksi (Block 73) verstarkt und ergibt die Zielbeschleunigung cpKDZiei- Ein nachgeschaltetes Begrenzungsglied 69 
20 begrenzlden Wert auf die maximale Beschleunigung ±<p Dmiw Uih das dynamische Verhalten zu verbessem, wird bei Bil- 
dung der Soll-Ist-Wert-Differenz zwischen Zielgeschwindigkeit und derzeitiger SoU-Geschwindigkeit berucksichtigt, 
daB durch die Ruckbegrenzung ±<p omax bei der derzeitigen Soll-Beschleunigung ipKDref nur die maximale Geschwindig- 
keitsanderung 

25 



35 



^9Dmzx = TT-* (1) 



max 



erreichbar ist, die im Block 71 berechnet wird. Deshalb wird dieser Wert auf die aktuelle SoU-Geschwindigkeit cpKDrcf 
30 addiert, wodurch die Dy namik des Gesamtsystems verbessert wird. Hinter dem Begrenzungsglied 69 liegt dann die Ziel- 
beschleunigung (pKDZiei von Mil der gegenwartigen Sollbeschleunigung ipKDref wird wiederum eine SoU-Ist-Wert-Diffe- 
renz gebildet. Im KennHnienbiock 75 wird daraus der Soli-Ruck q> ^Dnf gemaB 



+ ^Z>max fiir pKDZiel ' 9KDref > 0 
'<PKDrcf = ^ 0 fiir <PKD2iel ^ 9KDref = 0 (2) 

~ 9^'£>max fi»r VKDZiel " 9KDref < 0 



40 gebildet. Durch Filterung wird der blockfonnige Verlauf dieser Funktion abgeschwacht. Aus der nun berechneten SoU- 
ruckfunktion ipKDref werden durch Integration im Block 65 die SoU-Beschleunigung (pKDref die SoU-Geschwindigkeit 
<p KDref und die Soli-Position q>KDZiei bestimmt. Die Ableitung des SoU-Ruckes wird durch Differentiation im Block 65 
und gleichzeitige Filterung aus dem SoU-Ruck 9 KDref bestimmt. 

1 0042] Im NormalbeUieb werden die kinematischen Beschrankungen cp omax "nd <i> Dmax sowie die Proportionalverstar- 

45 kung Ksi so vorgegeben, daB fur den Mitfahrer im Fahrkorb sich bei der Betatigung der Drehleiter ein subjektiv ange- 
nehnies und sanftes dynamisches Verhalten ergibt. Dies bedeutet, dafi maximaler Ruck und Beschleunigung etwas nied- 
riger angesetzt werden, als es das mechanischc System erlauben wurde. Jedoch ist insbesondere bei hdien \ferfahrge- 
schwindigkeiten der Nachlauf des Systems hoch. D. h. gibt der Bediener aus voUer Geschwindigkeit die Zielgeschwin- 
digkeit 0 vor, so benoligldie Drehleiter einige Sekunden bis sie zum Stillsiand kommt. Da derardge M>rgaben insbeson- 

50 dere in Notsituation mit drohender KolUsion gemacht werden, wird deshalb ein zweiter Betriebsmodus eingefuhrt, der 
einen Schneiistop der Drehleiter vorsieht. Hierzu wird dem Steilheitsbegrenzer fur den Normalbetrieb 61 ein zweiter 
Steilheitsbegrenzer 63 parallelgeschaltet, der struktureU einen identischen Aufbau hat, Jedoch werden die Parameter, die 
den Nachlauf bestimmen. bis zur mechanischen Belastbarkeitsgrenze der Drehleiter erhoht. Deshalb ist dieser Steilheits- 
begrenzer mit der maximalen SchneUstopbeschleunigung <pDraax2 und dem maximalen Schnellslopruck qi Dinax2 sowie 

55 die Schnellstop-Proportionalverstarkung Ks2 parametrisierl. Zwischen den beiden Steilheitsbegrenzem wird uber eine 
Umschaltlogik 67 hin- und hergeschaltel, die aus dem Handhebelsignal, den Notstop identifiziert. Ausgang des SchneU- 
stoi>-Steilheitsbegrenzer 63 ist wie beim Steilheitsbegrenzer fUr den Normalbeiueb der Soli-Ruck ^KDwf. Die Berech- 
nung der anderen Zeitfunktionen erfolgt auf gleiche Art und Wcise wie beim Normalbetrieb im Block 65. 
(0043] Damit stehen am Ausgang des halbautomatischen Bahnplaners ebenso wie beim vollautomadschen Bahnplaner 

60 die Zeitfunktionen fiir die Sollxx>sition des Fahrkorbes in Drehrichtung und deren Ableitung unter Beriicksichtigung der 
kinematischen Beschrankungen zur Verfugung. 

[0044] Die Zeitfunkdonen werden auf die Achsregler gegeben. Zunachst soU die Struktur des Achsreglers fur die 
Drehachse anhand Fig. 7 erlautert werden. 

[0045] Die Ausgangsfunktionen des Bahnplanungsmoduls in Form der SoUfahrkorbposition in Drehrichtung sowie de- 
65 ren Ableitungen (Geschwindigkeit, Beschleunigung, Ruck, und Ableitung des Ruckes) werden auf den \brsteuerungs- 
block 71 gegeben. Im Vorsteuerungsblock werden diese Funkdonen so verstarkt, daB sich resultierend ein bahngenaues 
Fahren der Leiter ohne Schwingungen unter den idealisierten V^raussetzungen des dynamischen ModeUs ergibt Grund- 
lage fur die Bestimmung der Vorsteuerungsverstarkungen ist das dynamische ModeU, das in den folgenden Abschnitten 
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fur die Drehachse hergdeitet wird. Daniit ist unter diesen idealisierten Vorausselzungen das Schwingen der Drchleiter 
unterdriickl. und der Fahrkorb folgi der generierten Bahn. 

[0046] Da jedoch Siorungen wie Windeinflusse auf die Drehleiter wirken konnen und das idealisierte Modell die real 
vorhandcnen dynamischen Verhaltnisse nur in Teilaspekten wiedcrgeben kann, kann optional die Vorsteuerung um einen 
Zustandsreglerblock 73 erganzi werden. In diesein Block wird mindestens eine der MeBgroBen Drehwinkel <po, Dreh- 5 
winkelgeschwindigkeit ^ d, Biegung des Leitersatzes in horizonlaler Richtung CDrehrichtung) Wh oder die Ableitung der 
Biegung wh verstarkt und wieder auf den Stelleingang ruckgefuhrt. Die Ableitung der MeBgroBen <(>d und Wh wird nu- 
nierisch in der Mikroprozessorsleuerung gebildel. 

1 0047J Da die hydraulischen Antriebsaggregaie durch nichtlineane dynamische Higenschaften (Hysterese, 'ibtgang) ge- 
kennzeichnet sind, wird der nun aus Vorsteuerung und optional Z^standsreglerausgang gebildete Wert fUr den Stellein- lo 
gang ui>ref im Block Ilydraulikkompcnsation 75 so verandcrt, daB sich resultierend lineares Verhalten des Cesamtsy- 
stems annehmen lafil. Ausgang des Blockes 75 (Hydraulikkompensation) ist die korrigierte StellgroBe ustD- Dieser Wert 
wird dann auf das Proportionalventil des Hydraulikkreislaufes fiir die Drehachse gegeben. 

[0048] Zur detaillierten Erlauterung der Vorgehensweise soli nun die Herleitung des dynamischen Modells fur die 
Drehachse dienen, die Grundlage fiir die Berechnung der Vorsteuerungsverstarkungen und des Zustandsreglers ist. 15 
[0049] Hierzu gibl Fig. 8 Erlauterungen zur Definition der Modell variablen. Wesentlich ist dabei der dort gezeigle Zu- 
sammenhang zwischen der Drehposition %y des l^ilergetriebes beziiglich des Inertialsystems mil den Einheitsvektoren 
eii bis ei3 und der Korbdrehposition q>KD» die wegen der Biegung Wh fUr kleine Biegungen gemSB dem Zusammenhang 



(5) 

1 

QfD ^^PD^^StD ^kompr ' 
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berechnet wird. I ist dabei die I^eiterlange. IMeses dynamische System kann durch die folgenden Differentialgleichungen 
beschrieben werden. 

(4) 

- ml cos (Pa'^D-^^^' + ^DL ' >Wi + (^DL (0 • >v^A = 0 

[0050] Jd ist das Tragheitsmoment des Leiteigeuiebes und des Leitersatzes um die Drehachse. mx ist die Masse des 
Fahrkorbes, m ist die reduzierte Masse, die sich aus der Modellbetrachtung ergibt, daB die homogene Massenverteilung 
des Leitersatzes auf zwei Punktmassen reduziert wird. Die eine Punktmasse wird auf den Drehniittelpunkt im Leiteige- 
triebe reduziert, die zweite Punktmasse ist der Mittelpunkt des Fahrkorbes. Dementsprechend berechnet sich die redu- 35 
zierte Masse aus der Gesamtmasse des leitersatzes gemaB m = mLa. Der Parameter a wird aus Frequenzgangmes- 
sungen bestimmt. Mmd ist das antreibende Motordrehmomenl. bo ist die viskose Reibung des Drehantriebes. Die erste 
Gleichung von (4) beschreibt im wesentlichen die Bewegungsgleichung fur das Drehleiteigetriebe, wobei die Ruckwir- 
kung durch die Biegung des Leitersatzes auf das Drehleiteigetriebe berucksichtigt wird. Die zweite Gleichung von (4) ist 
die Bewegungsgleichung, welche die Biegung Wh beschreibt, wobei die Aniegung der Biegungsschwingungjdurch die 40 
Drehung des Leitersatzes iiber die Winkelbeschleunigung des Drehleitetgetriebes oder eine auBere StOrung, ausgedruckt 
durch Anfangsbedingungen fiir diese Diiferentialgleichungen, verursacht wird. In der zweiten Gleichung von (4) ist da- 
bei der Parameter cdl die Steifigkeit des Leitersatzes und boL Diimpfungkonstante fur die Leiterschwingung. Fiir die 
Steifigkeit wird, da diese stark vom Ausfahrzustand des Leitersatzes 1 abhangt, eine Funktion in Abhangigkeit von 1 aus 
FEM Simulationen berechnet. Deshalb ist im weiteren fur cdl stets cdl(1) anzunehmen. Dies gilt auch fUr das aus kon- 45 
struktiven Daten berechnete TVagheiUmoment Jd, das ebenfalls eine Funktion in Abhangigkeit von 1 ist. 
[0051] Der hydraulische Antrieb wird durch die folgenden Gleichungen beschrieben. 

V 

^MD= ~^PD ^PD = ^komprQcD so 

^ . K . 
QCD = QfD - Y^^D 



55 



60 



[00521 in ist das Obersetzungsverhaltnis zwischen Motordrehzahl und Drehgeschwindigkeit des Leiteigetdebes, V ist 
das Schluckvolumen des Hydraulikmotors, Apo ist der Druckabfall iiber dem hydraulischen Antriebsmotor, ^ ist die Ol- 
kompressibilital, Qcd ist der Kompressibilitatsstrom, Qfd ist der Forderstrom im Hydraulikkreis fiir das Drehen und KpD 
ist die Proportionalitatskonstante, die den Zusammenhang zwischen Forderstrom und Ansteuerspannung des Poroprtio- 
nalventils angibt. Dynamische Efifekte der unterlagerten Farderstromregelung werden vemachlassigt. 65 
[0053] Die Gleichungen konnen nun in Zustandsraumdarstellung (siehe auch O. Follinger; Regelungstechnik, 7. Aufl., 
Hiithig Verlag, Heidelbez^, 1992) transformiert werden. £s ergibt sich die folgende Zustandsraumdarstellung des Sy- 
stems. 
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ZusLandsraunidarstellung 

(6) 



Zustandsvektor 
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UD = UStD (8) 



yD = <PKU (9) 



0 



'"('^ DK - »»/ ) 
0 



1 



Steueigr3Be 



AusgangsgioBe 



Systenunatrix 
0 

0 — 



0 



0 
/ 



0 0 1 0 

bpJ bo 1 



0-- 



cosip^iJoK -ml^) cos<p^{Joi^ -ml^) cos"^ VaC^dk -ml ) cos^ tPAi-^DK 
0 0 0 -io^ ^ 



(10) 



Steuervektor 
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0 
0 
0 

0 

Inp 



(11) 



60 



= |^-j01000 



A usgangs vektor 



(12) 



65 [0054] Das dynamische Mcxiell der Drehachse wird als parameterveranderliches System bezUglich der AusfahrlSnge 1 
und dcs Aufrichtwinkels <pA aufgefaBt. Die Gleichungen (6) bis (12) sind Grundlage fur den nun beschriebenen Entwurf 
der Vorsteuerung 71 und des Zustandsreglers 73. 

[0055] EingangsgroBen des Vorsteuerungsblock 71 sind die SoU-Winkelposition <pKDrefr die Soll-Winkelgeschwindig- 
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keit 9KDref9 die SoU-WinkeLbeschleunigung cpKDrcf <^er Soil-Ruck ipKDrcf und ggf. die Ableilung des Soil-Rucks. Der 
FtlhrungsgroBen wd isl daniit 

VKDref 
<PKDref 

9KDref (13) 
9KDref 
(^KDref) 

(0056] Tm Vorsleuerungshlock 71 werden die Komponenlen von wd mit. den Vorsleuerungsverstarkungen Kyoo bis 
KvD4 gewichtel und deren Summe auf den Stelleingang gegeben. Im Falle, daB der Achsregler fiir die Drehachse kcinen 
Zustandsreglerblock 73 umfaBt, ist dann die GroBe upvoi^t dem Vorsteuerungsblock gleich der Referenzansteuerspan- 
nung Uorcf, die nach Kompensation der Hydraulik-Nichtlinearitat als Ansteuerspannung u^tD auf das Proportionalventil 
gegeben wird. Die Zustandsraumdarstellung (6) erweitert sich dadurch zu 



mit der Vorsteuerungsmatrix 
Sd — [KvDoKvDiKvDiKvDS^vm] 



(14) 



(15) 



lU 
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25 



[0057] Wrd die Matrizcnglcichung (14) ausgcwcrtct, so kann als algcbraischc Glcichung fiir den \brstcucrungsblock 
geschrieben werden, wobei Udvoxbi die unkorrigierte Sollansteuerspannung fiir das Proportionalventil basierend auf dem 
idealisierten Modell ist. 

^^Dvorst = f^VD^^KDref ^VDX^KDref + ^VDl^KDref + ^Voi'PKDref i'^^yD4^KDref) i^^) 

[0058] Die Kvdo bis Kvd4 sind die Vorsteuerungsverstarkungen die in Abhangigkeit des aktuellen Aufrichtwinkels <Pa 
und der Ausfahrlange 1 des Leitersatzes berechnet werden, daB der Fahrkorb ohne Schwingungen bahngenau der SoUtra- 
jektorie folgt. 

[0059] Die Vorsteuerungsverstarkungen Kvdo bis Kym werden wie folgt berechnet. Beziiglich der RegelgroBe Fahr- 
korb winkel <Pkd laBt sich die t)bertragungsfunktion ohne \^rsteuerungsblock wie folgt aus den Zustandsgleichungen (6) 
bis (12) gem^ dem Zusanmienhang 



angeben. Daraus folgt fur die fjbertragungsfunktion der folgende Ausdruck: 

^PD^D f^^n 



- (w(l - COS <Pa )5 + b^L s + C£,£ ) 



(17) 
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m 



,2 



fi^^ (18) 
[0060] Nun muB der Vorsteuerungsblock bei der Obertragungsfunktion beriicksichtigt werden. Dadurch wird aus (18): 

(19) 



<PKDref 

[0061] Dieser Ausdruck hat nach Ausmultiplizieren die folgende Struktur: 



50 



55 



60 



65 



7 



BNSDCX3ID: <DE 100iei37Al_L> 



DE 100 16 137 A 1 

= 5 (20) 

VKDref ,.,a2'S^ ^a^'S-^a^ 

5 

[0062] Zur Berechnung der Verstarkungen KvDi(XvDo bis Kvim) sind lediglich die Koeffizienten b4 bis bo und 84 bis ao 
von Interesse. Ideales Systcmveiiiallen beziiglich Position, der Geschwindigkeii, der Beschleunigung, des Ruckes und 
ggf. der Ableitung des Ruckes eigibt sich genau dafiir, wenn die Obertragungsfunktion des Gesamtsystcixis aus \^rsteue> 
rung und Obertragungsfunktion der Drehachse d^ Drehleiter nach Gl. 19 bzw. 20 in ihren Koeilizienten bj und ai den fol- 
io genden Bedingungen gentigt: 

^ = 1 (21) 

[0063] Dieses lineare Gleichungssysieiii kann in analylischer Form nach den gesuchlen \brsLeueningsverslHrkungen 
KvDu bis KvD4 aufgclost wcrdcn. 

[0064] Beispielhaft sei dies fur den Fall des ModeUs nach Gl. 6 bis 12 gezeigt. Die Auswertung von GL 19 eigibt fUr 
die Koeffizienten bj und a; 
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^0 = ^VDO 



^\ 5 

^ i V 

«3 ^JdK^DL^^^^Va -^b^ibQ-^m 



«4 = Jdk^dl cos^ 159^ + Wi^o (22) 



[0065] Das Gleichungssysteni (22) ist linear bezuglich der Vorsteuerungsverstarkungen Kvdo bis Kvd4 und kann nun 
nach Kvdo bis Kvd4 aufgelost werden. Damit erhalt man die Vorsteuerungsverstarkungen Kvdo bis Kvd4 zu: 
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K 



VOX 



2nK 



PD 



'^VD2--r—n. (23) 



K 



KZ)3 



K£>4 



i^cjyi^PK cos^ (Jx) +mKr) + COS (PAmipV) 

mcos<pji{-b[ii-~—-¥CDibD)p2n 
An^P 



10 



15 



Dies hat zum Vorteil, daB diese Vorsteuerungsverstarkungen nunniehr in Abhangigkeit von den Modellparame- 20 
tem vorliegen. Im Falle von Modell nach (51. (6) bis (12) sind die Systemparameter Kpo, io* V, I, P. Jd. m. niK, cdl» 

[0067] Die Verandcrung von Modellparametem wie des Aufrichtwinkels ((>a und der Leilerlange 1 kann sofort in der 
Veranderung der Vorsteuerungsverstarkungen berucksichtigt warden. So konnen diese in Abhangigkei! der MeBwerte 
von (pA und 1 stets nachgefuhrt werden. Das heiBt, wird mit der Achse Aus/Einfahren eine andere Ausfahrlange 1 des Leit- 25 
ersatzes angefahren, so verandem sich dadurch autoniatisch die \brsleuerungsverstarkungen der Drt^achse, so daB re- 
sulticrcnd stcts das pcndcldainpfcndc Vcrhaltcn der Vorstcucrung bcim Vcrfahrcn des Fahrkorbcs crhaltcn blcibt. 
[0068] Desweiteren konnen bei tJbertragung auf einen anderen Drehleitertyp mit anderen technischen Daten (wie 
bspw. veranderies m) die Vorsteuerungsverstarkungen sehr schnell angepaBt werden. 

[0069] Die Parameter Kpo, io* V, P, m, hik,. stehen aus dem Datenblatl der technischen Daten zur Verfiigung. Als 30 
Korbmasse wird ein durchschnitdicher Wert oder ein MeBwert aus Sensordaten angenommen. Gnindsatzlich als veran- 
derliche Systemparameter werden die Parameter 1, <|>a aus Sensordaten ermittelt Die Parameter Jd, c^l sind aus FEM- 
Untersuchungen bekannL Die DSmpfungsparameter boL. bo werden aus Frequenzgangmessungen bestimmt. 
[0070] Mit dem Vorsteuerungsblock ist es nun moglich die Drehachse der Drehleiter so anzusteuern, daB unter den 
idealisierten Bedingungen des dynamischen Modells nach GL (6) bis (12) keine Schwingungen des Fahrkorbes beim 35 
Verfahren der Drehachse auftreten und der Fahrkorb der vom Bahnplanungsmodul generierten Bahn bahngenau folgt. 
Das dynamische Modell ist jedoch nur eine abstrahierte Wiedergabe der realen dynamischen Verhaltnisse. Zudem kon- 
nen auf die Drehleiter von auBen Storungen (Wie starker Windangriff o. a.) wirken. 

[0071] Deshalb wird der Vorsteuerungsblock 71 von einem Zustandsregler 73 unterstutzt. Im Zustandsregler wird min- 
destens eine der MeBgroBen Wh, w h» <Pd»9d» Mmd tnit einer Reglerverstarkung gewichtet und auf den Stelleingang zu- 40 
rtickgefiihrt. Dort wird die Differenz zwischen dem Ausgangswert des M>rsteuerungsblockes 71 und dem Ausgangswen 
des Zustandsreglerblockes 73 gebildet. Ist der 2kistandsreglerblock vorhanden, muB dieser bei der Berechnung der \br- 
steuerungsverstiirkungen beriicksichdgt werden. 
[0072] Durch die Riickftihrung verandert sich Gl. (14) zu 

[0073] Kp ist die Matrix der Reglerverstarkungen des Zustandsreglers. Dementsprechend verandert sich auch die be- 50 
schreibende Obertragungsfunktion, die Grundlage fiir die Berechnung der \brsteuerungsverstarkungen ist, nach (17) zu 

Gdr(s)= =Cp{sI-Ao + Bt^KDy^^D (25) 

[0074] Im Falle der Drehachse lautet die tJbertragungsfunktion im FaUe der Kuckfuhrung der GroBen Wh» w <|>d» 
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p4rr {cqi cos (Pawd-^^^k^ ) + ^£>*i:>x. + 5" )^ 



15 



(26) 

20 [0075] Die Variablen k^o, k2D» ^30, k4D sind die Reglerverstarkungen des Zustandsreglers, die die GroBen wi„ Wf,, ((>d, 
4>D. geeignet gewichtet auf den Stelleingang zuruckfuhren. 

[0076] Zur Berechnung der Vorsteuerungsverstarkungen KvDi(KvDO bis Kvim) wird wiederum zunachst (26) analog zu 
(19) uin die Auf schaltung der FtihningsgroBen erweitert. 

25 GyoRis) = = G^/? (^) ^ {Kyoo + ^KPl-^ + AVx)2^^ + KvDZ^^ + ^KD4^^) (27) 

9^KDref 

[0077] Dieser Ausdruck die gleiche Stniktur bzgl. KvDi(KvDO bis Kvd4) wie Gl. (20). Ideales Systemveiiialten bezug- 
licb Position, der GeschwindigkeiU der Beschleunigung, des Ruckes und ggf. der Ableitung des Ruckes eigibt sich genau 
30 dann, wenn die Ubertragungsfunktion des Gesaintsy stems aus Vorsteuerung und Ubertragungsfunktion der Drehachse 
der Drehleiter nach Gl. 27 in ihren Koeffizienten hi und at der Bedingung (21) geniigL 

[0078] Dies fiihrt wieder auf ein lineares Gleichungssystem analog zu (22), welches in analytischer Form nach den ge- 
suchten Vorsteuerungsverstarkungen Kvdo bis Kvd4 aufgelost werden kann. Jedoch sind die Koeffizienten bi und ai ne- 
ben den gesuchten Vorsteuerungsverstarkungen Kyoo bis Kvd4 nun auch von den bekannten Reglerverstarkungen kip, 
35 k2D» 1^3D» Zustandsreglers abhangig, deren Herleitung im folgenden Teil der Erfindungsbeschreibung erl^utert 

wird. 

[0079] Fur die Vorsteuerungsverstarkungen Kvdo bis Kvd4 des \brsteuerungsblockes 71 erhalt unter Beriicksichtigung 
des Zustandsreglerblockes 73: 

40 ^VDO ^ 

FT mcos^ Ir \ 

^VD2 - T—Z + V-k\D +/C3£)) 

^D^PD ^DL 

{Acp^pn^ cos^ <p^ {Jp 4- m^l^) ^ cos(p^milV) ^ 

A y£)^ = r 



50 



c 

DL 

.^^ ^ ».cos^,(-6„^,.i,K ^4;r^^o,<,o) ,^^0^^^^^^^^^^^ ^^^^^^ 

2c inKpry^ C 

(28) 

[0080] Damit sind mit Gl. (28) analog zu Gl. (23) die Vorsteuerungsverstarkungen bekannt, die ein schwingungsfreies 
65 und bahngenaues Verfahren des Fahrkorbes in Drehrichtung basierend auf dem idealisierten Modell garantieren. Jedoch 
sind nun die Zustandsreglerverstatkungen kio? ^20* ^30* zu bestimmen. Dies soil im weiteren erlautert werden. 
[0081] Die Reglernickftihrung 73 ist als Zustandsregler ausgefuhrt. Ein Zustandsregler ist dadurch gekennzeichnet, 
dafi jede ZustandsgrdBe, das heiBt, jede Komponente des Zustandsvektors xd mit einer Regelverst^ung kio gewichtet 
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wird und auf den Stelleingang der Strecke zuriickgeftihrt wird. Die Regelverstarkungen kio werden zum Regelvektor Kq 
zusaninicngefaBt. 

(00821 CjcinaB "Unbehauen, Regelungstechnik 2, a. a. O.", wird das dynamische Verhalten des Systems durch die Lage 
der liigenwcrle der Systemmatrix Ad, die zuglcich Pole der Obertragungsfunktion im Frequenzbereich sind, beslimmt. 
Die iMgenwenc der Matrix konnen durch Berechnung der NuUstellen bzgl. der Variablen s des charakteristischen Poly- 5 
noms aus dor Dclcrniinatc wic folgt bestimmt werden. 



dei(sl Ad) ^ 0 (29) 

[0083] I ist die liinheiisniatrix. Die Auswertung von (29) fOhrl im Falie des gewUhlten ZustandsraummcKtelLs nach Gl. lo 
6-12 auf ein Polynoni 5-lcr()rdnung dcrFcarni: 

+ a4s'* + a3S-^ + a2S^ 4- a,s + ^ 0 (30) 

[0084] Durch Ruckfuhrung der ZuslandsgroBen uber die Reglermatrix Kq auf den Steuereingang konnen diese Eigen- 15 
werte geziell vcrschobcn werden, da die Lage d&r Eigenwerte nun durch die Auswertung der folgenden Determinante be- 
stimml ist: 



det(sI-AD + Bo • K|)) = 0 (31) 

[0085] Die Auswcnung von (3 1 ) fuhrl wicdcr auf ein Polynom 5-ter Ordnung, welches jetztjedoch von den Rcglcrver- 
starkungen kio (i = 1 . .5) abhangl, Ini I'allc des Modells nach Gl. 6-12 wird (30) zu 

s^ + a4(k5D,)s'^ + a3(k5i> *mi> k2i))s^ + a2(k5,> k4i), kso, kiD)s^ + ai(k5D, k4D, k3D)s + ao(k3D) = 0 (32) 

[0086] Man fordert nun, daB durch die RcglcrvcrsLarkungen kjo die Gl. 31 bzw. 32 besliimnte NuUsLellen einniiiuiiL, 
um dadurch gcziclt die Dynaniik des Systems zu bccinflusscn, die sich in den NullstcUcn dieses Polynoms widcrspicgclt. 
Dadurch ergibt sich eine Vorgabc fur dieses Polynom gemaB: 

pis) = n(s-r.) (33) 

wobei n die Systemordnung ist, die mil der Dimension des Zustandsvektors gleichzusetzen ist. Im Falle des Modells nach 
GL 6-12 ist n = 5 und dainit p(s): 

p(s) = (s - ri)(s - r2)(s - r3)(s - r4)(s - rs) = s^ + p4s'* + p^s? + pzs^ + piS + po (34) 
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[0087] Die n sind so zu wahlen, daB das System stabil ist, die Regelung hinreichend schnell bei guter Dampfung arbei- 
tet und die StellgroBenbeschrankung bei typischen auftretenden Regelabweichungen nicht erreicht wird Die n konnen 
vor Inbetriebnahme in Simulationen nach diesen Kriterien bestimmt werden. 40 
[0088] Die Regelverstarkungen k6nnen nun durch Koeffizientenvergleich der Polynome GL 31 und 33 bestimmt wer- 
den. 



45 



deiisl-A^ -SrB^ K^)^h{s-ri) (35) 

1=1 

[0089] Im Falle des Modells nach GL 6-12 eigibt sich folgendes lineares Gleichungssystem in Abhangigkeit von den 
Regelverstarkungen ki^: 

a4(k5D)-P4=0 50 

a3(k3D, k4D, k2D) - P3 = 0 

a2(k5D, k4D, k3D, kio) - P2 = 0 (36) 
ai(k5D. k4D, k3D) - Pi = 0 

ao(k3D)-po = 0 

55 

[0090] Die Auswertung des obigen Gleichungssystems (36) tiihrt nun auf analytische mathematische Ausdrucke fur 
die ReglerversiMrkungen in Abhangigkeit von den gewUnschten Polen r, und den Systemparametem. Im FaUe von Mo- 
dell nach GL 6-12 sind die Systemparameter Kpo, io, V, 1, (p^, Jo, m, mx, cdl» ^ui^y t>D- Vorteilhaft bei diesem Regler- 
entwurf ist, daB jetzt Parameterveranderungen des Systems, wie der Ausfahrlange 1 oder des Aufrichtwinkels <Pa sofort in 
verSnderten Reglerverstaricungen beriicksichtigt werden konnen. Dies ist fUr ein optimierles Regel verhalten von ent- 60 
scheidender Bedeutung. 

[0091] Da ein vollstandiger Zustandsreglo- die Kenntnis aller Zustandsgr6Ben verlangt, ist es vorteilhaft, anstatt eines 
Zustandsbeobachters die Regelung als Ausgangsriickfuhrung auszufuhren. Dies bedeutet, daB nicht alle ZuslandsgroBen 
iiber den Regler zuruckgefuhrt werden, sondern nur die, die durch Messungen erfaBt werden. Es werden also einzelne kjo 
zu Null. Im Falle des Modells nach Gl. 6 bis 12 konnie beispielsweise die Messung des AnUiebsmomenls des Drehach- 65 
seamotors entfallen. Damit wird kso = 0. Die Berechnung der kio bis k4D kann trotzdem nach GL (36) erfolgen. Zudem 
kann es sinnvoll sein, aufgnind des nicht unerheblichen Rechenaufwandes fiir einen einzelnen Arbeitspunkt die Regler- 
parameter zu berechnen. Es muB jedoch anschlieBend die talsachliche Eigenwertlage des Systems mit der Reglermatrix 
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KD=[kiDk2Dk3Dk4D0] (37) 

iiber die Berechnung nach Gl. 31 nunierisch uberpruft werden. Da dies nur numerisch erfolgen kann, muB der gesamte 
durch die veranderlichen Systemparameter aufgespanntc Raum erfaBt werden. In diesem FaJIe waren die veranderlichen 
5 Systemparameter 1 und (p^- Diese Parameter schwanken im Intervall [Imu,. Ima*] fc>zw. [(pAminr <PAmax]- D. h. in diesen In- 
tervallen mussen mchrere Stutzstellen li bzw. <|>Aj gcwahlt werden und fiir- alle moglichen Kombinationen dieser veran- 
derlichen Systemparameter die Systemmatrix Aij(li, <pAj) berechnet und in Gl. 31 eingesetzi und mil aus Gl. 37 aus- 
gewertet werden: 

11) det(sl - Aij + B • Kd) = 0 fUr alle i, j (38) 

[0092] Bleiben stets alle Nullstellen von (38) kieiner Null, so ist die Stabilitat dcs Systems gewahrt und die ursprung- 
lich gewahllen Pole rj konnen heibehalten werden. Tst dies nicht der Fall, so kann eine Korrektur der Pole r^ nach Gl. (33) 
erforderlich werden. 

15 [0093] Ausgang des Zustandsreglerblock 73 ist bei Ruckfiihrung von Wh, Wh, <()d»9d d^nn 

UDriick = kiDWh + k2Dn Wh + )^3D<?D + k4D <Pd (39) 

[0094] Die Sollansteu^spannung des Proportionaiventils ftir die Drehachse ist unter Berucksichtigung der V^rsteue- 
20 rung 71 dann 

"Dref = UDvoret - UOriick (40) 

[0095] Da im Zustandsraummodell nach GL 6-12 nur lineare Systemanteile berucksichtigt werden konnen, konnen op- 
25 tional statische Nichtlinearitaten der Hydraulik im Block 75 der Hydraulikkompensation so berucksichtigt werden, daB 
sich resultierend ein lineares SysLeinverhallen be:&uglich des Sysleuicingangs eigibl. Die wesenllichslen nichtlinearen 
EHcktc der Hydraulik sind der Totgang dcs Proportionaiventils um den NuUpunkt und HystcresccfTektc der untcrlagcrtcn 
Forderstiomregelung. Hierzu wild experimentell die statische Kennlinie zwischen Ansteuerspannung Usto des Propor- 
tionaiventils und deni resultierenden Fordersttom Qfd aufgenommen. Die Kennlinie kann durch eine mathematische 
30 Funktion beschrieben werden. 

QFD = f(UStD) (41) 

[0096] Beziiglich des Systemeingangs wird nun Linearitat gefordert. D. h. das Proportionalventil und der Block der 
35 Hydraulikkompensation sollen gemafi Gl. (5) zusammengefaBt folgendes Ubertragungsverhalten haben. 

Qfd = KpDUstD (42) 

[0097] Hat der Kompensationsblock 75 die statische Kennlinie 

40 

UstD = h(UDr«f) (43) 

so ist Bedingung (42) genau dann erfiillt, wenn als statische Kompensationskennlinie 
45 h(UD«f) = r^(KpDUD«f) (44) 
gewahlt wird. 

[0098] Damit sind die einzelnen Kompenenten des Achsreglers fiir die Drehachse erlautert. Resultierend erfiillt die 
Kombination aus Bahnplanungsmodul und Achsregler Drehen die Anforderung einer schwingungsfreien und bahnge- 
50 nauen Bewegung mit der Diehachse. 

[0099] Aufbauend auf diesen Etgebnissen soli nun der Achsregler fUr die Achse Aufrichten/Neigen 7 erlautert werden. 
Fig. 9 zeigt die grundsatzliche SUruktur des Achsregler Aufrichten/Neigen. 

[0100] Die Ausgangsfunktionen des Bahnplanungsmoduls in Form der Sollfahrkorbposition in Richtung der Achse 
Aufrichten/Neigen sowie deren Ableitungen (Geschwindigkeit, Beschleunigung, Ruck, und Ableitung des Ruckes) wer- 

55 den auf den Vorsteuerungsblock 91 (Block 71 bei Drehachse) gegeben. Im Vorsteuerungsblock werden diese Funktionen 
so verstarkt, daB sich resultierend ein bahngenaues Fahren der Leiter ohne Schwingungen unter den idealisierten Vbraus- 
setzungen des dynamischen Modelis ergibt. Grundlage fUr die Besdmmung der Vorsteuerungsv^stlirkungen ist das dy- 
namische ModelU das in den folgenden Abschnitten fUr die Achse Aufrichten/Neigen heigeleitet wird. Damit ist unter 
diesen idealisierten Voraussetzungen das Schwingen der Drehleiter unt^xlriickt und der Fahrkorb folgt der generierten 

60 Bahn. 

[0101] Wie bei der Drehachse kann zum Ausregeln von Storungen (z. B. Wndeinfliisse) und Kompensieren von Mo- 
dellfehlem optional die Vorsteuerung um einen Zustandsreglerblock 93 (vgl. Drehachse 73) erganzt werden. In diesem 
Block wird mindestens eine der MeBgroBen Aufrichtwinkel <Pa. Aufrichtwinkelgeschwindigkdt <i)A, Biegung des Leit- 
ersatzes in vertikaler Richtung Wy oder die Ableitung der vertikalen Biegung Wy verstarkt und wieder auf den Stellein- 
65 gang rtickgefiihrt. Die Ableitung der MeBgr5Ben <Pa un^ Wv wird numerisch in der Mikroprozessorsteuerung gebildet. 
[0102] Aufgrund der dominanten statischen Nichtlinearitat der hydraulischen Antriebsaggregate (Hysterese, Totgang) 
wird der nun aus Vorsteuerung UAvomt und optional Zustandsreglerausgang UAnick gebildete Wert fiir den Stelieingang ua- 
lef im Block Hydarulikkompensadon 95 (analog zu Block 75) so verSndert, dafi sich resultierend lineares Verhalten des 
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Gesamtsystems annehnien laBt. Ausgang des Blockes 9S (Hydarulikkompensation) ist die korrigierte Stellgr&Be UstA- 
Dieser Wert wird dann auf das Propoitionalventil des Hydraulikkreislaufes fiir den Zylinder der Achse Aufrichten/Nei- 
gen gegeben. 

[0103] Zur detaillierten Erlauterung der Vorgehensweise soli nun die Herleitung des dynamischen Modells fur die Auf- 
richtachse dienen, die Grundlage fur die Berechnung der Vorsteueningsverstarkungen und des Zuslandsreglers ist. 
[0104] Hierzu gibt Fig, 10 Erlaulerungen zur Definition der Model Ivarbiablen. Wesenllich ist dabei der dort gezeigtc 
Zusammenhang zwischen der Aufrichtwinkelposilion (p^ Leitergetriebes bezuglich des In ertialsy stems mil den Ein- 
heitsvcktoren eii bis ei3 und der Korbaufrichtwinkelposition (Pka» <lie wegen der Biegung Wv fur kleine Biegungen geniaS 
dem Zusaminenhang 

berechnet wird. Dieses dynainische System kann durch die foigendeh DiSerentialgleichungen beschrieben werden. 

(46) 

-ml ipA +/«->^'v-*-^^L •>^v+^/li(0 >^V =0 

[0105] Ja ist das Tragheitsmoment des I^itersatzes um die Aufrichtachse. Mma ist das antreibende Drehmoment des 
Hydraulikzylinders auf die Leiter. b^ ist die viskose Reibung im Hydraulikzylinder. Die erste Gleichung von (4) be- 
schreibt im wesentlichen die Bewegungsgleichung bezuglich der Aufrichtkinematik mit dem antreibenden Hydraulikzy- 
linder der Leiter, wobei die Ruckwirkung durch die Biegung des Leitersatzes beriicksichtigt wird. Die zweite Gleichung 25 
von (4) ist die Bewegungsgleichung, welche die Biegung Wy beschreibt, wobei die Anregung der Biegungsschwingung 
durch das Aufrichtcn bzw. Ncigcn des Leitersatzes iibcr die Winkelbcschlcunigung odcr cine auBcrc Stoning, ausge- 
druckt durch Anfangsbedingungen fur diese Differentialgleichungen, verursacht wird. In der zweiten Gleichung.von (4) 
ist dabei der Parameter Cal die Steifigkeit des Leitersatzes und bAL die Dampfungkonstante fUr die Leiterschwingung in 
Richtung der Achse Aufrichten/Neigen. FUr die Steifigkeit wird, da diese stark vom Ausfahrzustand des Leitersatzes I 30 
abhangt, eine Funktion in Abhangigkeit von 1 aus FEM Simulationen berechnet. Deshalb ist im weiteren fUr Cal stets 
Cal(I) anzunehmen. Dies gilt auch fur das aus konstrukliven Daten berechnete Tragheitsmoment Ja, das ebenfalls eine 
Funktion in Abhangigkeit von 1 ist. Die nicht genannten Parameter sind den Angaben zu Gl. 4 der Drehachsc zu entneh- 
men. 

[0106] Der hydraulische Antrieb wird durch die folgenden Gleichungen beschrieben. 35 

A//1 = Pzyi^b COS (pp ((Pa ) 
^Zyl = PZyl^Zyl 

^Zyl "^-^ (QfA -^Zyl^Zyl(<PA^<PA)) ^"^^^ 

Qfa = ^PA^^StA 

[0107] Fzyi ist die Kraft des Hydraulikzylinders auf die Kolbenstange, pzyi ist der Druck im Zylinder (je nach Bewe- 
gungsrichtung kolben- oder ringseidg), Azyu ist die Querschnittsflache des Zylinders (je nach Bewegungsrichtung kol- 
ben- Oder ringseitig), P ist die Olkompressibilitat, Vzyi ist das Zylindervolumen, Qfa ist der Forderstrom im Hydraulik- 
kreis fur das Aufrichten und Neigen und KpA ist die Ftopordonalitatskonstante, die den Zusammenhang zwischen For- 50 
derstrom und Ansteuerspannung des Propordonalventils angibt. Dynamische Effekte der unterlagerten Forderstromrege- 
lung werden veraachlassigt. Bei der Olkompression im Zylinder wird als relevantes Zylindervolumen die Halfte des Ge- 
samtvolumens des Hydraulikzylinders angenommen. zzyi, z zyi sind die Position bzw. die Geschwindigkeit der Zylindcr- 
stange. Diese sind ebenso wie die geometrischen Parameter 4, und cpp von der Aufrichtkinematik abhangig. 
[0108] In Fig, 11 ist die Aufrichtkinematik der Aufrichtachse daigestellt. Der Hydraulikzylinder ist am unteren Ende 55 
im Drehleitergetriebe veranken. Aus Konstruktionsdaten kann der Abstand d^ zwischen diesem Punkt und dem Dreh- 
punkt des Leitersatzes um die Aufrichtachse entnommen werden. Die Kolbenstange des Hydraulikzylinders ist am Leit- 
ersatz im Abstand d^ befestigt. <po ist ebenfalls aus Konstruktionsdaten bekannt, Daraus IMBt sich der folgende Zusam- 
m^hang zwischen Aufrichtwinkel <Pa und Hydarulikzylinderposition zzyi herleiten. 



40 



45 



60 



[0109] Da nur der Aufrichtwinkel 9a MeBgroBe ist, ist die umgekehrte Relation von (48) sowie die Abhangigkeit zwi- 
schen Kolbenstangengeschwindigkeit z zyi und Aufrichtgeschwindigkeit 4> a ebenfalls von Interesse. 65 
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<Pji = arccos( — — i-) - q>Q 



dz 



Zyl 



(49) 



(50) 



10 rOIIOI T^'ur die Hcrechnung dcs wirksamen Monientes auf den Leitersatz isi auBeidem die Berechnung des Projektions- 
winkels 9p crfordcrlich. 



15 



20 



4^1 "^dl- 2d^d^ cos(q>^ + ^o) 



(51) 



[0111] Daniii kann das in den Gl. 46-5 1 beschriebene dynamische Modell der Aufrichtachse nun in die Zustandsraum- 
darstellung (siehc auch O. I'ollingcr: Rcgciungstechnik, 7. Aufl., HUthig Verlag, Heidelberg, 1992) transformiert werden. 
Es ergibtsich die foigcndc /usiandsraumdarstcllung des Systems. 



25 {LA 
mit: 



ZustandsraumdarstelLung 
(52) 



30 



35 



M'v 
<PA 
U^MAl 



Zustandsvektor 



(53) 



40 



Ua = ustA (54) 



SteueigroBe 



45 



SO 



55 



60 



65 



Xa = 9ka (55) 



0 



1 



0 



0 



iJAK-"in iJAK-mn 



0 



AusgangsgroBe 
Systemmatrix 

0 

0 

0 
0 

0- 



0 

bAt 



iJAK-ml^) 
1 

bA 

(JAK-ml^) 



0 

/ 



2 A' 



Zyl 



fi^Zyl {dl +dl- 2di,d„ cos{(p^ + Pq)) 



iJAK-"'n 
0 
1 

{JAK-»nl^) 
0 



JAJciO^JAiD + mjcl^ 



(56) 
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Steuervektor 



0 
0 

0 



2Azyidi,d^ sin(9>^ + <Po)Kp^ 



^ZylP^^l 2cli,da cos(^>^ + (po) 



(57) 



Ausgangsvektor 



(58) 



[0112] Das dynamische Modell der Drehachse wird als paraineterveranderliches System bezuglich der Ausfahrlange 1 
und der trigonometrischen Funktionsanteile des Aufriditwinkels <|)a aufgefaBt. Die (ileichungen (52) bis (58) sind 
Grundlage fiir den nun beschriebenen Entwurf der \brsteuerung 91 und des Zustandsreglers 93. 

[0113] EingangsgroBen des Vorsteuerungsblock 91 sind die Soll-Winkelposition (|>ka? die SoU-Winkelgeschwindigkeit 
9ka» <lie Soli-Winkelbeschleunigung <Pka» der Soil-Ruck ^Pka und ggf. die Ableitung des Soli-Rucks. Der Fiihrungs- 
groBen Wa ist damit analog zu (13) 

9>KAre/ 
<PKAref 

<PKAref (59) 

'^KAref 
i^K.4ref) 

{0114] Im Vorsteuerungsblock 91 werden die Komp>onenten von wa niit den Vorsteuerungsverstarkungen Kvao bis 
KvA4 gewichtet und deren Summe auf den Stelleingang gegeben. Im Falle, daB der Achsregler fur die Aufrichtachse kei- 
nen Zuslandsreglerblock 93 umfaBt, isl dann die GroBe UAvorst ^^is dem Vorsteuerungsblock gleich der Referenzansteuer- 
spannung UArcf» die nach Kompensation der Hydraulik-NichUinearitat als Ansteuerspannung ustA auf das Proportional- 
ventil gegeben wird. Die Zustandsraumdarstellung (52) erweitert sich dadurch analog zu (14) zu 



(60) 



niit der Vorsleuerungsmatrix 

= [KvA0KvAlKvA2KvA3KvA4] (61) 

[0115] Wird die Matrizengleichung (60) ausgewertet, so kann als algebraische Gleichung fur den \brsteuerungsblock 
geschrieben werden, wobei Uavotsi die unkoirigierte Sollansteuerspannung fiir das Proportional ventil basierend auf dem 
idealisierten Modell ist. 

^^Avorst = f^VAOVKAref + f^VAX^KAref + ^VAl^KAref + f^VAl9>KAref i^^VA^^KAref ) (^2) 

10116] Die Kvao bis Kva4 sind die Vorsteuerungsverstarkungen die in Abhangigkeit des aktuellen Aufrichtwinkels ipA 
und der AusfahrlSnge 1 des Leitersatzes berechnet werden, daB der Fahrkorb ohne Schwingungen bahngenau der SollUra- 
jektorie folgt. 

[0117] Die Vorsteuerungsverstarkungen Kvao bis Kva4 werden wie folgt berechnet. Bezuglich der RegelgroBe Fahr- 
korhwinkel q)KA laBt sich die Ubertragungsfiinktion ohne Vorsteuerungsblock wie folgt aus den Zustand.sg1eichungen 
(52) bis (58) gemaB dem Zusammenhang 

G(5) = J^M^ = isl - (63) 

^^Avorsty^) 

angeben. Analog zu Gl. (18) kann mit Gl. (63) die Ubertragungsfunktion zwischen Ausgang \forsteuerungsblock und 
Fahrkorbposition berechnet werden. Unter Beriicksichtigung des Vorsteuerungsblockes 91 in Gl. (63) erhalt man eine 
Beziehung analog zu (il. (19) die nach Ausmultiplizieren die Form 
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J ^54j 

V>KAref ,..02 S +«i-5 + ^() 

5 

hat. Zur Berechnung der Verstaricungen KyaiCKvao bis Kva4) sind lediglich die Koeffizienten b4 bis bo und 84 bis ao von 
Inteiesse. Ic^ales Systemverhallen bezuglich Position, der Geschwindigkeii, der Beschleunigung, des Ruckes und ggf. 
der Ableitung des Ruckes eigibl sich genau dann, wenn die LFbertragungsfunktion des Gesamtsy stems aus Vbrsteuerung 
und Ubertragungsfunktion der Aufrichtachse der Drehleiter den Bedingungen nach Gl. (21) tiir die Koeffizienten bi und 
10 ai gentlgL 

[0118] Daraus ergibt sich wiederuin ein lineares Gleichungssystem, das in analytischerrorm nach den gesuchten \br- 
steuerungsverstarkungen Kvao bis Kva4 aufgelost werden kann. 

[0119] Fur den Fall des Modells nach Gl. 52 bis 58 ergibt sich analog zuni Rechenweg bei der Drehachse (Gl. 1 8-23) 
dann fiir die \^steuerungsverstarkungen 
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20 



Ky^Q = 0 



K 



VA\ 



^PAh 



^^b^Zyl'^PA^l 
^ JAKCALPyZylh'l'^lmAly^dlh'l 

^db<^AL^2ylKpAhh\ 

Ky^4 _J 

^^b<^AL^Zyl^PAh^\ 



wobei: /M = ^|da + -Zrf^rf^ cosiip^ + (po) ^^^^ 

[0120] Wie schon bei der Drehachse gezeigt, hat dies zum Vorteil, daB die Vorsteuerungsverstarkungen in Abhangig- 
40 keit von den Modellparametem vorliegen. Im Falle von Modell nach Gl. 52 bis 58 sind die Systemparameter KpA, Azyi, 
Vzyi, cpA, p. Ja. ni, niK, cal> bAL» bA, db, da. iiber die Abhangigkeit der Parameter Ja, Cal von der Leiterlange ist auch ein 
Abhangigkeit vom Parameter 1 gegeben. 

[0121] Damit kann die Veranderung von Modellparametem wie des Aufrichtwinkels <|>a und der Leiterlange 1 sofort in 
der Veranderung der Vorsteuenmgsverstarkungen beriicksichtigt werden. So konnen diese in Abhangigkeit der MeB- 

45 werte von <Pa und 1 slets nachgefiihrt werden. Das heiBt, wird mit der Achse Aus/Binfatiren eine andere Ausfahrlange 1 
des Leitersatzes angefahren, so verandem sich dadurch automatisch die X^rsteuerungsverst^kungen der Drehachse, so 
daS resultierend stets das pendeldampfende Verhalten der Vorsteuerung beim Verfahren des Fahrkorbes erhalten bleibt. 
[0122] Des wdteren konnen bei Ubertragung auf einen anderen Drehleitertyp mit anderen technischen Daten (wie 
bspw. verandertes m) die Vorsteuerungsverstarkungen sehr schnell angepafit werden. 

50 [0123] Die Parameter KpA, Azyi, Vzyi, P, m, mx, db, da stehen aus dem Datenblatt der technischen Daten zur Verfiigung. 
Als Korbmasse wird ein durchschnittlicher Wert oder ein MeBwert aus Sensordaten angenommen. Grundsatzlich als ver- 
anderliche Systemparameter werden die Parameter 1, (p^ aus Sensordaten ermittelt. Die Parameter Ja, c^l sind aus FEM- 
Untersuchungen bekannt Die Dampfungsparameter bAL, bA werden aus Frequenzgangmessungen bestimmt. 
[0124] Mit dem Vorsteuerungsblock ist es nun moglich die Aufrichtachse der Drehleiter so anzusteuem, daB unter den 

55 idealisierten Bedingungen des dynamischen Modells nach Gl. 52 bis 58 keine Schwingungen des Fahrkorbes beim >fer- 
fahren der Aufrichtachse auftreten und der Fahrkorb der vom Bahnplanungsmodul generi^ten Bahn bahngenau tblgt. 
Das dynamische Modell ist jedoch nur eine absurahierte Wiedergabe der realen dynamischen Verh^misse. Zudem kon- 
nen auf die Drdileiter von aufien Stoningen (z. B. starker WindangrifF o. a.) wirken. 

[0125] Deshalb wird der \forsteuerungsblock 91 von einem Zustandsregler 93 unterstutzt. Im Zustandsregler wird min- 
60 destens eine der MeBgroBen w^^ w v» <Pa, ^a, Mma einer Reglerverstarkung gewichtet und auf den Stelleingang zu- 
riickgefuhrt. Dort wird die Differenz zwischen dem Ausgangswert des Vorsteuerungsblockes 91 und dem Ausgangswert 
des Zustandsreglerblockes 93 gebildet. Ist der Zustandsreglerblock vorhanden, muB dieser bei der Berechnung der Vor- 
steuerungsverstarkungen beriicksichtigt werden. 
[0126] Durch die Ruckfuhning verandert sich Gl. (60) zu 

65 
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(67) 

y,=^A-iA 

5 

10127J Ka isl die Matrix dcr Reglerverstarkungen des Zustandsreglers der Aufrichlachse analog zur Reglenmatrix Kd 
der Drehachse. Analog zum Rechenweg bei der Drehachse von Gl. 25 bis 28 verandert sich die beschreibende Ubertra- 
gungsfunktion 

GAR(s) = ~^^^ = C^isJ-A^ ^B^K^T'B^ (68) 

[0128] Trn Falle der Aufrichlachse konnen bei spiel weise die GroBen Wv, Wv> <(>a» 9a ^.uruckgefuhrt werden. Die korre« 
sfxjndierenden Reglerverstarkungen vohKa sind hierzu k^A. k2A, k^A. k4A. 

10129] Nach Beriicksichtigung der Vorsteuerung 91 in Gl. 68 konnen die Vorsteuerungsverstarkungen KvAi(KvAO bis 15 
KvA4) nach der Bedingung von Gl. 21 berechnet werden. 

[0130] Dies fiihrt wieder auf ein lineares Gleichungssystem analog zu GL 22, welches in analytischer Form nach den 
gesuchten Vorsteuerungsverstarkungen Kvao bis Kva4 aufgel6st werden kann. Es sei jedoch angemerkt, dafi die Koeffi- 
zienten bi und aj neben den gesuchten Vorsteuerungsverstarkungen Kvao bis Kva4 nun auch von den bekannten Regler- 
verstarkungen kiA, k2A» k3A» k4A des Zustandsreglers abhUngig sind. 20 
[0131] Fiir die Vorsteuerungsverstarkungen Kvao bis Kva4 des Vorsteuerungsblockes 91 erhalt unter Berucksichtigung 
des Zustandsreglerblockes 93 analog zu Gl. 28 bei der Drehachse: 

^PA^^\ 

JC ^AfiVzyliH m ml 

^^'^^ ^T7~l P 1 ^3-4 ^'lA 30 

'^^b^Zyi^PA^l ^AL ^AL 

A (/'_^3 = 1 1 r~ 

'^CALAzyl^PA^^lh^b <^AL 

AL 

.2 . -,„.^2 .2/.2, 



*ni>ALi^AA -lk2A) , tttblijlkxA - ^a) 



(69) 



det(5/ -A^-^B^K^)^ U{s - r, ) 
(69a) 



35 



"^^CAlbAP^Zyl^^ -^^^'Azyidbh^b^^ ^ 2m^{k:^^-Ik^^) ^ 

2cli^AzyiKp^h2df,hy c^i : 40 



45 



[0132] Mit Gl. 69 sind nun auch die Vorsteuerungsverstarkungen bekannt, die ein schwingungsfreies und bahngenaues 
Verfahren des Fahrkorbes in Drehrichtung basierend auf dem idealisierten Modell unter Berucksichtigung des Zustands- 
reglerblockes 93 garantieren. Jedoch sind nun die Zustandsreglerverstarkungen kiA» k2A> k3A, k4A zu bestiminen. Dies 50 
soil im weiteren erlautert werden. 

[0133] Die Reglerriickfuhrung 93 ist als Zustandsregler ausgetiihrt. Die Reglerverstarkungen berechnen sich analog 
zum Rechenweg von GL 29 bis 39 bei der Drehachse. 

[0134] Die Komponenten des Zustandsvektors xa werden mit den Regelverstarkungen J^a der Reglermatrix Ka ge- 
wichtet und auf den Stelleingang der Strecke zuriickgefiihrt. 55 
[0135] Wie bei der Drehachse werden die Reglerverstarkungen fiber Koeffiezientenveigleich der Polynome analog zu 
GL 35 



60 



bestinunt. Da das Modell der Aufrichlachse wie das der Drehachse die Ordnung n = 5 hat, sind die Polynome in GL 69a 
ebenfalls 5-ter Ordnung. Im Falle des Modells nach GL 52 bis 58 eigibt sich folgendes lineares Gleichungssystem in Ab- 65 
hangigkeit von den Regelverstarkungen kiA- 
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'^(k5A)-P4=0 
a3(k5A, k4A, k2A) ~ P3 = 0 
a2(k5A> k4A. k3A, k^A) ~ P2 = 0 (70) 
ai(k5A,k4A, k3A)~Pi =0 
5 ao(k3A)-po = 0 

wobei die pi(po bis P4) die KoeHizientcn des durch die Nuislellen t\ definierten Polynoms sind. 

r0136] Die Fj sind so zu wahlen, daB das System stabil ist, die Regelung hinreichend schnell bei guter Dampfung arbci- 
tel und die SteligroBenbeschrankung bei typischen auftretenden Regelabweichungen nicht erreicht wird. Die t\ konnen 

10 vor Inbetriebnahnie in Simulationen nach diesen Kriterien bestimmt werden. 

[0137] Die Auswertung dcs Cleichungssy steins (70) fuhrt nun auf analytisciie mathematische Ausdriicke Pur die Reg- 
lerverstarkungen in Abhangigkeit von den gewunschten Polen r, und den Systemparanietern. Im Falle von Modeil nach 
Gl. 52 bis 58 sind die Syslemparameter KpA, A^yu Vzyi, <^a. Ja, hik, Cal, bAL, bA, db, d^. Uber die Abhangigkeit der 
Parameter Ja, Cai. von der Leiterlange ist auch ein Abhangigkeit vom Parameter 1 gegeben. Wie bei der Drehachse kon- 

15 nen jetzt Parameterveranderungen des Systems, wie der Ausfahrlange 1 oder des Aufrichtwinkels <|>a sofort in verander- 
ten Reglerverstarkungen berucksichtigt werden. Dies ist fur ein optimiertes Regelverhalten von entscheidender Bedeu- 
tung. 

[0138] Wie auch bei der Drehachse, kann der Zusiandsregler auch als Ausgangsruckfuhrung ausgefUhrt werden. In die- 
sem Fall werden nur die duich Messung erfaSten ZustandsgroBen zuruckgeflihrt. Dadurch werden einzelne kiA zu Null. 

20 Im Falle des Modells nach GL 52 bis 58 konnte beispielsweise die Messung des wirksamen Antriebsmoments des Hy- 
draulikzylinders entfallen. Damit wird ksA = 0. Die Berechnung der kiA bis k^A kann Urotzdem nach (j1. (70) erfolgen. 
Zudem kann es sinnvoU sein, aufgrund des nicht unerheblichen Rechenaufwandes die Reglerparameter fur einen festen 
Arbeitspunkt des Systems zu berechnen und die Nachfuhrung der Reglerparameter bei Abweichung von diesem Arbeits- 
punkt in Abhangigkeit vom Aufrichtwinkel und von der Ausfahrlange zu vemachlassigen. In beiden Fallen muB jedoch 

25 anschiieBend die tatsachliche Eigenwertlage des Systems mit der Reglermatrix 

KA=lkiAk2Ak3Ak4A0] (71) 

uber die Berechnung analog zu Gl. 31 numerisch iiberpriift werden. Da dies nur numerisch erfolgen kann, muB der ge- 
30 samte durch die veranderlichen Systemparameter 1 und <Pa aufgespannte Raum erfaBt werden. Diese Parameter schwan- 
ken im Intervall [Imin, IraaxJ bzw. [<pAmin, <(>Araax]- In diesen Intervallen werden mehrere Stiitzstellen li bzw. <pAj gewahlt 
und fiir alle moglichen Kombinationen dieser veranderlichen Systemparameter die Systemmatrix AAij(li, <|>Aj) berechnet 
und analog zu Gl. 3 1 eingesetzt und mit Ka aus Gl. 71 ausgewertet: ~ 

35 det(sl - Aau + Ba • Ka) = 0 fur alle i, j (72) 

[0139] Bleiben stets alle NullsteUen von (72) kleiner Null, so ist die Stabilital des Systems gewahrt und die urspriing- 
lich gewahlten Pole ti konnen beibehalten werden. Ist dies nicht der Fall, so kann eine Korrektur der Pole ri nach Gl. (69) 
erforderlich werden. 

40 [0140] Ausgang des Zustandsreglerblock 93 ist bei Ruckfuhrung von Wv> Wv, <Pa» <i>A dann 

"Aruck = kiAWv + k2A Wv + k3A9A + ^D<?A (73) 

(0141] Die Sollansteuerspannung des Proportionalventils fur die Drehachse ist unter Berucksichdgung der Vorsteue- 
45 rung 91 analog zu GL 40 dann 

UAref=UAvoKt-UArQck (74) 

[0142] Wie bei der Drehachse kdrinen optional Nichtlinearitaten der Hydraulik im Block 95 der Hydraulikkompensa- 
50 tion kompensiert werden, so daB sich resultierend ein lineares Systemverhalten beziiglich des Systemeingangs eigibt. Bei 
der Aufrichtachse konnen neben dem Ventiltotgang und der Hysterese Korrekturfaktoren fiir die Ansteuerspannung be- 
ziiglich der Ausfahrlange 1 und des Aufrichtwinkels <Pa, sowie fur den Verstarkungsfaktor KpA und den relevanten Zylin- 
derdurchmesser Azyi vorgesehen werden. Damit kann eine richtungsabhangige Strukturumschaltung des Achsteglers 
vermieden werden. 

55 [0143] Zur Berechnung der notwendigen Kompensationsfiinkuon wird experimentell die statische KennHnie zwischen 
Ansteuerspannung usto des Proportionalventils und dem resultierenden Forderstrom Cfe aufgenommen, diesmal auch in 
Abhangigkeit von 1, <Pa aufgenommen. Die Kennlinie kann durch eine mathematische Funktion beschrieben werden. 

QFA = f(UStA.l.<|>A) (75) 

60 

f01441 Beziiglich des Systemeingangs wird nun Linearitat gefordert. D. h. das Proportionalventil und der Block der 
Hydraulikkompensation sollen gemaB Gl. 47 zusammengefaBt folgendes tjbertragungsverhalten haben. 

Qfa = KpAUstA (76) 

65 

[0145] Hat der Kompensalionsblock 95 die statische Kennlinie 

UstA = h(UAref. I <Pa) (77) 
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SO ist Bedingung (76) genau dann erfiillt, wenn als statische Kompensationskennlinie 

h(UA«f) = f"^(KpAUA«f.l,<l>A) (78) 

gewahlt wird. 5 
[0146] Damit sind die einzelnen Kompenenten des Achsreglers fiir die Aufrichtachse eriauteru Resultierend erfiillt die 
Kombination aus Bahnplanungsmodul und Achsregler Aufrichten/Neigen die Anfoiderung einer schwingungsfreien und 
bahngenauen Bewegung des Fahrkorbes beim Aufrichten und Neigen, 

[0147J Im folgenden soil nun die Struktur des Achsreglers fiir die Achse zum Ausfahren und Eintahren der Leiler er- 
lauteri werden. Die Struktur des Achsreglers ist in Fig, 12 dargestellt Im Gegensatz zu den Achsreglem Drehen 43 und lo 
Aufrichten/Neigen 45 ist der Achsregler der Achse Aus/Einfahren 47, da diese Achse nur geringe Schwingungsneigung 
zeigt, niit einer herkomnilicben Kaskadenregelung niit einer ^uBeren Regelschleife fur die Position und einer inneren fur 
die Geschwindigkeit ausgest.at.tet. 

[0148] Voni Bahnplanungsmodul 39 bzw. 41 werden zur Ansteuerung des Achsreglers nur die Zeitfunktionen Sollpo- 
sition der Achse Aus/Einfahren Iref und die SoUgesch windigkeit i rcf bendtigt. Diese werden in einem Vorsieuerungsblock 1 5 
121 derart gewichtet, daB sich ein schnell ansprechendes und hinsichtlich der Position stationar genaues Systemverhalten 
ergibt Da hinter dem Vorsieuerungsblock unmittelbar der SoU-Istvergleich zwischen FiihrungsgroBe l^cf und MeBgroBe 1 
erfolgt, ist StationSritat bezOglich der Posidon dann erfuUt, wenn die Vorsteuerungsverstarkung fiir die Position 1 ist. Die 
Vorsteuerungsverstarkung fur die Soll-Gesch windigkeit 1^^ ist so zu bestitnmen, daB sich subjektiv ein schnelles aber 
gut gedampftes Ansprechverhalten bei der Handhebelbediehung ergibt Der Regler 123 fiir die Positionsregelschleife 20 
kann als Proportionalregler (P-Regler) ausgefiihrt werden. Die RegelverstSrkung ist nach den Knterien Stabilitat und 
hinreichende Dampfung des geschlossenen Regelkreises zu bestimmen. AusgangsgroBe des Reglers 123 ist die ideale 
Ansteuerspannung des Proportionalventils, Wie bei den Achsregler Drehen 43 und Aufrichten/Neigen 45 werden in ei- 
nem Kompensationsblock 125 die Nichtlinearitaten der Hydraulik ausgeglichen. Die Berechnung erfolgt wie bei der 
Drehachse (GL 42-44). AusgangsgroBe ist die korrigierte Ansteuerspannung des Proportionalventils pstE* Innere Regel- 25 
schleife fur die Geschwindigkeit isl die unterlagerte Forderstroiiunegelung des Hydraulikkreislaufes. 
[0149] Lctztc Achse der Drchlcitcr ist die Nivcauachsc, die dafiir sorgt, daB auch, wenn das Fahrzcug auf cincm ab- 
schussigen Gelange aufgebaut wird, das Leitergetriebe beim Drehen stets waagrecht bleibt, Um die Fahrzeugneigung zu 
erfassen ist im Drehleitergetriebe ein Elektrolytsensor installiert. der die Verkippung des Drehleitergetriebes beziiglich 
des Inertialsystems in zwei zueinander senkiecht stehenden Richtungra angibt. Diese beiden Winkel werden mit <|)nx und 30 
<()Ny bezeichnet. Um die Leiter stets exakt lotrecht ausgerichtet zu halten, ist nur der Winkel q>Nx entscheidend, da der 
zweite Winkel der Orientierung der Achse Aufrichten/Neigen entspricht. Um die Neigung auszugleich^ sind zwischen 
Drehkranz und Drehleitergetriebe zwei Hydraulikzylinder montiert, die das Drehleitergetriebe gegenuber dem Fahrzeug 
um einen Winkel (pNrei verkippen konnen. Ziel der Regelung ist es, beim Drehen den Winkel bezuglich des Inertial- 
systems stets Null zu halten, also par allele Ausrichtung bezuglich des Inertialsystems herzustellen, Vor dem Auflegen der 35 
Leiter muB die Leiter wieder in die fahrzeugparallele Ausrichtung gebracht werden. Hierzu werden vor dem Ausfahren 
der Leiter in aufgelegtem Zustand die Winkelsensoren <()nx und <|>Ny ausgelesen und dieser Wert als Fahrzeugneigung 
q>PNx und q)F>gy abgespeichert. Der Wert cppNx ist damit die Neigung des Fahrzeuges um die Langsachse, (ppi^y die Neigung 
um die Achse quer zur Fahrrichtung. Vor dem Auflegen werden diese Werte dazu verwendet, die Leiter wieder in die 
fahrzeugparallele Ausrichtung zu bringen. ^ 40 

[0150] Die Struktur des Achsreglers fiir die Niveauachse ist in Fig. 13 dargestellt Der Aufbau mit einem Kjaskaden- 
regler mit einer auBeren Regelsclileife fur die Position und einer inneren fur die Geschwindigkeit entspricht dem der 
Achse Aus/Binfahren. 

[0151] In der Grundausbaustufe entfallt die Vorsteuerung 131. WShrend des Betriebs der loiter mit eingeschaltener 
Niveauausregelung wird stets der SoUwert Null bezuglich <pNx angenommen. Der Regler 133 wandelt die SoU-Ist-Wert- 45 
Differenz zwischen dem aktuellen MeBwert (pNx dem Sollwert Null in eine Ansteuerspannung UNref um. Der Regler ist als 
Proportionalregler ausgefuhrt. Die Regelverstarkung ist nach den Knterien Stabilitat und hinreichende Dampfung des 
geschlossenen Regelkreises zu bestimmen. AusgangsgroBe des Reglers 133 ist die ideale Ansteuerspannung des Propor- 
tionalventils. Wie bei den anderen Achsreglem werden in einem Kompensationsblock 135 die Nichtlinearitaten der Hy- 
draulik ausgeglichen. Die Berechnung erfolgt wie bei der Drehachse (GL 42-44). AusgangsgroBe ist die korrigierte An- 50 
steuerspannung des Proportionalventils usin. Innere Regelschleife fiir die Geschwindigkeit ist die unteriagerte Forder- 
stromregelung des Hydraulikkreislaufes. 

[0152] Soli die Dynamik des Achsregler verbessert werden, kann der Achsregler um eine \brsteuerung 131 eiganzt 
werden. In der Vorsteuerung werden vom Bahnplanungsmodul die fur die Niveauachse relevanten Zeitfunktionen <|>KDref 
und die Sollgeschwindigkeit ipKOrcf der Drehachse benotigt. Diese werden zunachst im \forsteuerungsblock 131 in Soil- 55 
werte fiir den Kippwinkel (f)Ncei gem^ 

9NiekoU = -<|>NxCOS<|>KjDref " <PNySin<l>KDref (79) 

umgerechnet. Damit ist 60 

^NrclsoU = (<l>NxSin<(>KDrcf - <|)NyCOS<PKDrcf) ^>KDref (80) 

[0153] In guter Naherung kann man fiir den Hydraulikkreislauf der Niveauachse vereinfachend annehmen 

^rcl = KpNgesUstN (81) 

wobei KpNges die resultierende Ciesamtverstarkung der tJbertragungsfiinktion zwischen Kippgeschwindigkeit <pNrei und 

19 
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Ansteuerspannung isu A^rd nun 
1 

^StM = ^Nreholl (82) 

5 ^PNges 

gewahlt, wird durch diese Vorsteuerung in Ei:ganzung zuni Regler 133 das dynamische Verhalten weiter verbessert. Vor 
dem Auflegen wird auf den SoUwert fur den Kippwinkel bezUglich des In^tialsystems der Fahrzeugkippwinkel i^p^^ ge- 
geben. Damil sorgt die Niveauachse in Kombination mil der Drehachse auch beim Drehen'bei gegebener Fahrzeugnd- 
gung fiir eine stets waagrechte Lage der Leiter. 
10 f0154] Damil ist eine Drehleiter realisiert, deren Bahnsteuerung ein bahngenaues Verfahren des Fahrkorbes mil alien 
Achsen erlaubt und dabei aktiv Schwingungen des Leilersatzes unterdriickt. 
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Paten lanspriiche 



1. Drehleiler oder dergleichen mil einer Steuerung fiir die Bewegung der Leiterteile, dadurch gekennzeichnet, 
daB die Sleuerung derarl ausgebildet isl, daB beim Vferfahren des Fahrkorbes Schwingungen der Leiterteile unt«-- 
dnickt werden und der Fahrkorb auf einer voigegebenen Bahn gefQhrt wird, indem das idealisierte Bewegungsver- 
halten der Leiter in eineni dynamischen Model! basierend auf Differenzialgleichungen abgebildet wild und die 
Steuerung die AnsteuergroBen der Antriebe der Leiterteile fur eine im wesentlichen schwingungsfreie Bewegung 

20 der Leiter aus dem dynamischen Model I berechnet. 

2. Drehleiter nach Anspruch 1 , dadurch gekennzeichnet, daB ein Bahnplanungsmodul fiir die Erzeugung der Bewe- 
gungsbahn der Leiter im Arbeitsraum vorgesehen ist, das die Bewegungsbahn in Form von Zeitfunkdonen fiir die 
Fahricorbposition, Fahrkorbgeschwindigkeit, Fahrkorbbeschleunigung und gegebenenfalls Ruck an einen Vbrsteue* 
rungsblock abgibt, der die Antriebe der Leiterteile ansteuert. 

25 3. Drehleiter nach Anspruch 2, dadurch gekennzeichnet, daB das Bahnplanungsmodul die Eingabe von kinemati- 

schen Beschrankungen fur die Zeilfunktionen TUr die Fahrkorbposidon, Fahrkorbgeschwindigkeit, Fahrkorbbe- 
schleunigung und den Fahrkorbruck gcstattct 

4. Drehleiter nach Anspruch 3, dadurch gek^nzeichnet, daB das Bahnplanungsmodul auch die Zeitfunktion fur die 
Ableitung des Rucks erzeugt. 

30 5. Drehleiter nach Anspruch 3 und 4, dadurch gekennzeichnet, daB das Bahnplanungsmodul Steilheitsbegrenzer 

zur Berucksichtigung der kinemati schen Beschrankungen enthalt. 

6. Drehleiter nach Anspruch 5, dadurch gekennzeichnet, daB das Bahnplanungsmodul stetige Funktionen des 
Rucks erzeugt und aus diesen durch Integration die Zeilfunktionen fur Fahrkorbbeschleunigung, Fahrkorbge- 
schwindigkeit und Fahrkorbposidon erniittelL 
35 7. Drehleiter nach Anspruch 5 oder 6, dadurch gekennzeichnet, daB das Bahnplanungsmodul einen weiteren Steil- 

heitsbegrenzer umfaBt, der im Falle eines Notstopps den Nachlauf des Fahrkorbs verkiirzt. 

8. Drehleiter nach einem der Anspriiche 1 bis 7, dadurch gekennzeichnet, daB die Steuerung elekuische Steuersi- 
gnale zur Steuerung hydraulisch^ Proportionalventile der Antriebe der Leiter liefert. 

9. Drehleiter nach Anspruch 8, dadurch gekennzeichnet, daB die Anuiebe zur Drehung der Leiter um die Hoch- 
40 achse zum Aufrichten und Absenken der Leiter und zum Ausfahren und Einfahren der Leiter in deren Langsrich- 

tung vorgesehen sind, 

10. Drehleiter nach einem der Anspruche 1 bis 9, dadurch gekennzeichnet, daB neben dem Vorsteuerungsblock und 
dem Bahnplanungsmodulmodul ein Zustandsregler vorgesehen ist, der durch gewichtete Ruckfuhrung von MeBgro- 
Ben auf die AnsteuergroBen der Leiterseite Schwingungen des Leitersatzes kompensiert. 

45 11. Drehleiter nach Anspruch 10, dadurch gekennzeichnet, daB der Zustandsregler mindestens eine der MeBgioBen 

- Drehwinkels der Leiter. Aufnchtwinkel, Ausfahrlange, und/oder der Leiterbiegung in horizontaler und vertikaler 
Richtung - aufnimnit, diese geeignet gewichtet und auf die Steuereingange der Leiterteile zuruckfuhrt. 
12. Drehleiter nach Anspruch 11, dadurch gekennzeichnet, daB der Zustandsregler die MeBwerte der MeBgroBen 
uber konstante Verst^ungen verstSrkt 

50 13. Drehleiter nach Anspruch 11, dadurch gekennzeichnet, daB der Zustandsregler die MeBwerte der MeBgr6Ben 

mit einer variablen, adaptiven Verstarkung verstarkt. 
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